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ADAPTIVE FILTER MODEL FOR MOTOR VEHICLE SENSOR SIGNALS 

Field of the Invention 

The present invention relates generally to a system for integrating sensors of 
physical parameters, and more specifically to a system for sensor fusion in a wheeled 
vehicle. 

In the current development within vehicle technology there is an increasing 
interest in enhancing the safety and the manoeuvrability of vehicles by means of a number 
of support systems. Examples of welMcnown support systems in wheeled vehicles are anti- 
lock brake systems (ABS)» traction control systems and tire pressure esj:imation.sy5tems. 
This kind of systems are usually provided with more or less complex sensors such as 
gyroscopes and wheel speed sensors to gather infonnation about physical parameters 
affecting the vehicle. 

Along with the development of technology there is an increasing demand for 
safety enhancing equipment in standard cars, something ^ch is not always compatible 
with an acceptable price level on this segment of cars. There is therefore a n ^ for 
developing cost efficient sensor equipment while improving the usability of thesensgr. 
signals. 

An important parameter for automatic support systems, such as dynamic stability 
traction control (DSTC), is the course direction of the vehicle. The course is usually 
expressed in terms of the yaw angle, which is the direction of motion relating to a 
longituduml axis of the vehicle, and the yaw rate, which is the angular velocity of the 
rotation of the vehicle around its centre of gravity m the horizontal plane. 

In a simple approach, the yaw rate is indqMmdently calculated from different 
sensors in the velucle, such as a gyxo sensor, ABS sensors, an accelerometer sensor or a 
steering wheel angle sensor, and thus resulting in different values of the yaw rate. These 
values have been compared and voting has been used to decide which information to use. 

Sensor signals generally comprise a parameter value and an ofiEset from the true 
parameter value. The of&ets are due to imperfect knowledge of the parameters and their 
dependencies, and the offsets vary in time due to for example temperature changes and 
wear. An accurate estimation of the offsets is crucial to the ability of accurately estimating 
the parameter value itself. The traditional way to improve sensor signals is to use a low pass 
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filter in order to get rid of high frequency variations, and sometimes an offset can be 
estimated using long term averaging. Averaging has its shortcomings. For example in yaw 
rate estimation, a systematic circular driving will give the same effect as an offset 
Furthermore, if two sensor signals measuring the same physical parameter are averaged, an 
S improved estimate of the parameter may be obtained but it does not help in estimating the 
ofEset 

The perhaps most well known support parameter for the driver of a wheeled 
vehicle is the velocity. The vehicle velocity may be estimated based on the angular velocity 
of the driven wheel, however with an inaccuracy due to wheel slip, wheel sicid or varying 

1 0 tire diameter. The standard ^>proadi to compute velocity is to use the wheel speed signals 
fiom the wheel speed sensors and possibly averaging over left and right wheels. To avoid 
errors due to wheel slip die non-driven ^niaeels are preferably used. This approach has, 
however, shortcomings during braking when the wheels are locked and during wheel spin 
on 4 wheel-driven (WD) vehicles. For 4 WD vehicles an additional problem is that even 

1 S during normal driving there will be a small positive velocity offset due to the wheel slip. 

Thc$tftt?9fth?Art 

An example of the state of the art sensor utilisation is shown in US Patent No. 
5,878,357 to Sivashankar et al. This piece of prior art is directed to vehicle yaw rate 

20 estimation by a combination of a kinematic yaw rate estimation and a dynamic yaw rate 
estimation using accelerometers. A kinematic yaw rate estimate is weighted with a vehicle 
lateral acceleration at the centre of gravity, and steering angle and vehicle forward speed are 
incorporated imo a Katanan filter for achieving a dynamic vehicle yaw rate estimate. This 
system uses relatively low*co5t sensor components but is sensitive to difiScult driving cases 

25 and errors in the wheel radii, for example dtie to varying tire pressure. Another drawback is 
that it requires wiring through the whole car in order to collect sensor sigxials fiom an 
accelerometer at the front as well as the rear of the car. 

Another example of prior art directed to yaw rate measuring is found in US 
Patent No. 5,274,576 to Williams. This prior art uses a solid state rate gyrometer, the 

30 accuracy of which is known to depend on the ambient temperature. Measuring means 

provides a velocity signal, a steering angle and a lateral acceleration signal, which are all 
used in a correction means in order to remove bias errors from the output signal of the 
gyrometer. It is noted that this system is basically a low pass filter only compensating for 
long term bias errors. 
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The US Patent No. 5,860,480 to Jayaraman et ai shows a method for determining 
pitch and ground speed of an earth moving noachine, and is directed to estimating certain 
operating parameters. This prior art seeks to overcome problems of noise and bias in sensor 
signals. Using a sensor measurement model, a machine process model and Kalmah filter 
S update equations the pitch, the pitch rate and ground speed are estimated as a ftmction of 
sensed pitch and ground speed signals. 

The European Patent No. EP 0 595 681 Al to Regie Nationale des Usines 
Renault shows a method for detennining the speed of a vehicle by processing sensed wheel 
angular velocity in a Kahnan filter. 

10 

The Object of the Invenrion 

The general problem to be solved by the present invention is to improve the 
usability of signals from existing sensors measuring a first physical parameter. 

Aspects of the problem are: 
IS to improve the accuracy of such sensors signals; 

to achieve a virtual sensor signal for a second physical parameter dependent on said first 
physical parameter, 

to use and combine sensor information from different available sources in order to achieve 
improved parameter estimates or virtual sensor signals; 
20 to accurately estimate and eliminate offsets from parameter values in the sensor signals. 

A further and more specific aspect of the problem is to provide an improved 
computation of a course indication in the shape of yaw angle and yaw rate for a wheeled 
vehicle. 

Yet another specific aspect of the problem is to provide an improved estimation 
25 of the velocity of a wtieeled vehicle. 

A further aspect of the problem is to compute the actual fuel level and 
instantaneous fuel consumption for any engine, ^ere offset distorted measurements of the 
same quantities are available. 

Yet another specific aspect is to compute the roll angle of a vehicle, in particular 
30 for motorcycles. 



Summary pf tt^^ Kftvei^tiPP 

The object of the invention is achieved by processing a plurality of sensor signals 
in an adaptive or recursive filter thereby producing an optimized estimation of a first 
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physical parameter detected by said sensors. In accordance with the invention, a particularly 
advantageous recursive filter is provided by a Kalman filter. In the invention, the Kalman 
filter is used as a framework for processing related sensor signals and estimating their 
respective offsets. These related sensor signals do not necessarily have to measure the same 
physical parameter, and in embodiments of the invration diey usually represent different 
parameters. Besides giving an accurate estimate of the ofEset, the Kahnan filter also has the 
advantageous possibility of attenuating noise. 

The invention achieves an increase of performance in existing sensors by 
enhancing the sensor signal. Furthermore, new infomiation is found by combining and 
processing sensor signals and associate the resuh with other physical or operating 
parameters than those directiy related with the sensors. 

According to an aspect of the invention, the accuracy of sensor signals are highly 
improved by combining the signals of a plurality of existing or simple add-on sensors in the 
recursive filtering means. 

According to another aspect of the invention, a virtual sensor signal for a second 
physical parameter dependent on one or more first physical parameters is generated by 
combining sensors of different type sensing different first physical parameters by 
means of combined sensor signals from real sensors. In other terms, all available 
information from sensors in the vehicle is systematically fused in a recursive filter, 
preferably a Kahnan filter. 

When applying the sensor fusion in accordance with the invention in computing a 
yaw rate value, at least two sensor signals are input into a Kalman filter in order to 
minimize the enw in an estimate signal representing the yaw rate value. In a preferred 
embodiment, diese sensors signals are a yaw rate signal taken from a gyro, wheel speed 
signab taken from an ABS equipment, possibly also a lateral yaw rate sigiial computed 

fiom a latetal accelerometer and steering wheel angle signals. An accurate yaw rate value 

can for example be applied in lateral slip compulation, which is used in stability systems 
and friction estimatioxt Furthennore» there are effects of the second order^ for example an 
estimation of absolute tire radii and consequentiy also absolute velocity. Moreover, the 
filtering process provides computations of differraces in tire radii as well as signals for 
diagnosis of &ults in the respective sensors. The diagnosis signals may be used to warn the 
driver or be stored in a fault report to be used in connection with service of the vehicle. 

An accurate estimation of vehicle velocity is achieved in accordance witii an 
embodiment of the invention wfamin wheel speed sensor signals are combined with an 
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accelerometer signal and processed in a filtering process in accordance with the above 
description* In accordance with the invention, the velocity is accurately computed even 
during braking and when the wheels are locked. For a 4 WD vehicle or when non-driven 
wheel speed signals are not available, the invention compensates for wheel slip and in 
addition to velocity also gives acceleration information. Other parameters that are derived in 
embodiments of the invention are $lip-of£set e.g. usable for tire pressure cs jimatiqn iiiJJWP--> 

vehicles^ slip-slope e.g. usable for tire friction estimation in 2 WD and 4 WD^eeluciesr-- 

acceleration offset and the wheel velocity in the drive direction. These embodiments as well 
as detection of aquaplaning are examples of application of theory for the longitudinal 
stiffiiess of tires. 

The slip of a vehicle wheel is a function of the momentum applied on a wheel, 
wherein the slip-offset is a constant term of the function and the slip-slope is the constant of 
proportionality between the applied momentum and the slip. 

There are different further aspects that are relevant to different kinds of vehicles. 
Yaw rate and absolute velocity estimation is perh^s most appropriate for cars and trucks. 
For motorcycles, the determination of roll angle is important for an ABS and spin control, 
since less tire forcess can be utilised in cornering. Also, headlight control can be 
in4>lemented dependent on roll angle. Roll angle estimation is furthermore crucial for roll- 
over 

detection, used in some airbag control units. Similarly to yaw rate estimation in cars, this 
can be done by using wheel speed and a lateral-vertical accelerometer pair. Such a roll 
angle estimation carried out without using a roll gyro is an example of a virtual sensor, 
where only indirect measurements arc used to compute the physical quantity. It is here 
crucial to find and compensate for the accelerometer offsets, which is conveniently 
achieved with the aid of Ae invention.As a further support, a roll gyro and longitudinal 
accelerometer can be incorporated in die algorithm. Another example of great practical 
importance is to detect aqua-planing quickly, for cars, trucks and motorcycles. 

Other aspects and embodiments of the invention are disclosed in the description 
of detailed embdoiments and the claims. 

Brief Description of the Drawinps 

The invention will now be further described by means of exemplifying 
embodiments in conjunction with the accompanying drawings, in Mliich: 
Fig 1 A - ID show schematic block diagrams embodiments of the invention; 
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Fig 2A shows schematically an embodiment of the invention applied in yaw rate 
computation; 

Fig 2B shows the invention applied in velocity computation; 

Fig 2C shows the invention applied in fuel consumption computation; 

Fig 2D shows the invention applied in slip slope computation; 

Fig 3 A shows an embodiment of an autocalibrating sensor in accordance with the invention; 
Fig 3B shows a schematic drawing v^ch defines the geometric relations of a four wheeled 
vehicle; and 

Fig 4 shows a plot diagram of an estimated of&et in accordance with the invention from an 
e}q>erimental test drive; 

Fig SA and SB show coordinate systons and sensor configuration in a motorcycle; 

Fig 6 shows an embodiment of a virtual sensor for a roll angle indicator in a motorcycle; 

Fig 7 shows wheel geometry; and 

Fig 8 shows a schematic block diagram of a virtual sensor for an aqua planning detector in 
accordance with an embodiment of the invention. 

Detailed Description of Embodiments 

The invention is based on the followmg general idea of sensor fusion, which is 
here described by way of example in terms of matrix algebra. This example relates to two 
sensors detecting the same physical parameter, but in different embodiments of the 
invention signals from sensors detecting different parameters may be integrated. 

Two different sensors sensing the same varying physical parameter give separate 
measurements of a the parameter x, ^ere each measurement has an offeet bi with an 
ofi&et scaling cift) according to a known function of time. The measurements can be 
e^ressed algebraically as the equations: 



These two equations have three unknowns and is thoefore insoluble, and the of&ets cannot 
be directly elmunated. 

When two measurements j'/r/Ay^r^; nxidyl(2),y2(2) arc available, there are two 
more equations and only one more unknown, i.e. four equations and four unknowns. Thus» 
the offsets and the variable parameter values x(l),x(2) can be solved under the condition 
that there is no linear dependency in data. In this example, the linear independency 
condition is: 



(1) 

(2) 



yj(0'x(t)+cl(t)bl 
y2(l)'x(t) + c2(0b2. 
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(3) cl(l)/cl(2) ^ c2(l)/c2(2). 

If, for example, cl is constant and c2(t) is the velocity vx(t), linear independency 
occurs when the velocity has changed between two measurements. This leads to 
observability and idcntifiability. Typically, measurements would be carried out by sensors 
S delivering a continuous or discrete sensor output signal which is sampled into a digital data 
processing system. The samples axe collected in a per se known manner with a 
predetermined sampling fiequency, thus giving rise to a corresponding number of 
observations in the duqpe of equations to process. 

In practice there is a measurement noise added to each of the observations. In 
10 order to eliminate the noise, certain embodiments of the invention are devised to collect a 
number of observation samples large enough to constitute an overdetermined equation 
system and to compute the least square solution* 

The invention also makes use of the a priori knowledge that the parameter 
variable x is a correlated sequence that cannot change arbitrarily fast between two samples. 
1 S This propeity of the parameter variable x is used in a recursive filter, preferably a Kalman 
filter, into which the sanqpled observations input 

general $ettinB 

The invention is generally implemented in a digital or analogue sensor control 
20 system of a car. Such a system typically includes wired, optical or wireless data 

communication links for communicating the ouQjut of a sensor to a control unit. The control 
unit is provided with a data processor, which in preferred embodiments is a digital 
processor having a data storage memory and signal input and output ports. The digital 
processor is progranuned with a computer program product being provided with means for 
2S directing the processor to perform the functions and the steps of the inventive method. In an 
analogue implementation of the inventive concept, the control unit is provided with circuit 
elements specifically devised to p^orm the functions of the mventive method. 

Fig 1 shows a sch^natic diagram showing the functional blocks of the invention. 
Sensors or sensor signal suppliers 102,104,106,108, cq)able of generating sensor signals 
30 S1,S2,S3,S4 dependent on or representing a respective physical parameter, are coupled to a 
sensor mtegradon unit 1 10. For example, in one embodiment the ABS is used as sensor 
signal s upplier 102, the sensor 104 is a gyro, the sensor 106 is o ne or more accelerometers 
and the engine is a sensor signal si^plier lOS.The sensor mtegration unit comprises a 
recursive filter, preferably a Kahnan filter, devised to provide an estimate of a 
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predetermined physical parameter, and outputs a physical parameter signal PSSl to a first 
sensor signal processing unit, more specifically a self calibrating sensor, here called a 
viituid sensor signal processing unit 1 12, The virtual sensor signal processing unit 1 12 is 
devised to compute one or more vutual sensor signals VSS based on the physical parameter 
5 signal PSS 1 . The computed virtual sensor signal is for example the yaw rate T(dot), the 
velocity vx of the vehicle and the fuel consumption d V/Uei/dt. The virtual sensor signal is 
then conununicated to one or more control units 1 18, for example devised for controlling an 
ABS, a traction control system, a dynamic stability traction control system (DSTC ) or an 
adaptive cruise control system (ACQ. A roll angle detector is an example of both a virtual 

10 sensor when realised without a roll gyro and a self-caHbrating sensor realisedfaTcoi^wicSon 
with a roll gyro. The roll angle estimate can be used in xoUK)ver detection in cars and for 
improving ABS and anti-spm control and enabling headlight control in motorcycles. With 
the help of these virtual signals, aqua-planing can be detected with high reliability. 

In the embodiment shown in Fig 1, the sensor integration unit 1 10 outputs a 

1 S second physical parameter signal PSS2 to a second sensor signal processing unit, which 
perhaps more properly constitutes a virtual sensor but in this figure is called an intelligent 
sensor processing unit 1 14, devised to compute a complementary, intelligently computed 
sensor signal ISS used in a driver information processing unit 120. Such intelligent sensor 
signals may for example represent friction and tire conditions such as pressure or vibration. 

20 The sensor integration unit 1 1 0 is also devised to deliver a third physical sensor signal PSS3 
communicated to third sensor signal processing unit in the shape of a diagnosis signal 
processing unit 1 16, which outputs a diagnose signal DSS to the driver information 
processing unit 120. The driver information processing unit in its turn outputs signals for 
example indicating friction.conditions» tire pressure or faults in predetermined car 

25 components. Furthennore, a fourth physical parameter signal PSS4 may be delivered by the 
sensor integration unit to a fourth sensor signal processing unit, namely a vehicle control 
signal processing unit 117 devised to genemte and deliver suitable vehicle control signals 
VCS for example to vehicle operating apparatuses such as engine or brake control. 

30 Self^alibniffflK Sffpy>y 

Fig IB shows schematically die structure of a self-calibrating sensor in 
accordance with one embodiment of the invention, as explained in connection with 
equations 1-3. Two sensor signals y 1 and y2 representmg a physical parameter are input 
into an adaptive filter 122 deviced to estimate in accordance with a predeteremined model 
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and deliver as as output signal ofibets bl(hat) and b2 (bat) . The sensor signals y l,y2 are 
also input into an observability evaluation functionality together with possible external info 
128, the evaluation unit being deviced to output an enable signal 12S to the adaptive filter 
122 vihsn the conditions allow observability. The offset signal bi (hat) is joined with the 
S sensor signal yl in a substraction stage 126 where the value of the offset bl(hat) is 

substracted from the sensor signal value to produce a value or a quantity of a parameter X. 

Fig IC shows a general flow chart for the steps in a sensor fusion system, such as 
a self calibrating sensor m accordance with the mvention, comprising the following steps: 
Initializing the system; 
1 0 Receivmg as an iiq)ut the next measurement or sample from the sensors; 
Checking observabili^ of parameten 
If observability is OK then updating offset estunates; 

After uppdating of of&et estimates or if observability is not OK then compensate sensor 
signals with the offset output from the adaptive filter. 

15 

Virtual Sensor 

Fig ID shows schematically an example of a virtual sensor comprising an 
adaptive filter 136 based on a predetermined model integrating model parameters values 
representing first and second different physical or operating parameters. First and second 

20 sensor signals- yl and y2 representing said first and second different parameters are input 
into the filter 136 and into an observability evaluation unit 138. The observability 
evaluation unit 138 checks whether observability for the physical parameters is fiilfilled and 
if so outputs an enable signal 139 to the adaptive filter 136. In enabled condition, the 
adaptive filter 136 calculates and outputs an estimate of a physical quantity or value X(hat) 

25 together with an estimate of offiet values bl(hat) and b2(hat). The physical quantity X(hat) 
is tite value of a physical model X as a function £[yl,y2) dependent on the sensor signals y 1 
and y2. 

Yaw Rate Comnutarion 
30 One embodiment of die invention is directed to achieve an adaptive high 

precision yaw rate sensor by combining sensor signals from a gyro and firom wheel angular 
velocity sensors of an ABS and by computing an accurate yaw rate by means of an adaptive 
filter. Specific embodiments may comprise further sensor signals, for example the signals 
from a lateral accelerometer, in order to further enhance the perfonnance of the sensor. Fig 



WO01/769ZS 



10 



PCT/SEOI/00797 



2 shows schematically a yaw rate signal \ifgyro 202 from a gyro and wheel angular speed 
signals 204 ftom an ABS being inpxit in a filter 206 in accordance with the invention. The 
filter 206 outputs a computed yaw angle \if , yaw rate 208 as well as yaw rate offset 
values. 

Fig 3 A shows shematically a more detailed autocalibrating sensor for 
determining yaw rate, wherein a yaw rate signal ^jf from a gyro and angular velocity signals 
o)i for the wheels are is input into an adaptive filter 301 as well as into an observability 
evaluation unit 302. The evaluation unit 302 generates and inputs into the adaptive filter an 
enable signal 304 when the sensed parameters are observable. The adaptive filter 301 
generates as an output a yaw rate offset value 6gyro representing the offset of the yaw rate 
signal from the gyro. The yaw rate ^ and the offset value Sgyro are joined in a summation 
unit 303 producing a ^ -improved as an output 

Fig 3B shows a simple drawing of a four wheeled vehicle, which drawing defines 
the geometric relations for the wheel velocities during comerii^ used to compute yaw rate 
from wheel speed signals. More specifically, the relations are used to compute the curve 
radius, where R is defined as the distance to the centre of the rear wheel axle from a 
predetermined point O, L is the lateral distance between the wheels on one axle and B is the 
longitudinal distance between front and rear wheel axle. The wheels are in this example 
denoted as rl for rear left, rr for rear right,/ for front left and fr for front right. A coordinate 
system indicating the x,y, and z*directions is also drawn in Fig 38. For the sake of clarity of 
the drawing, the coordinate system is drawn in front of the vehicle, but is in reality typically 
positioned in the centre of gravity of the vehicle. 

For the sake of simplicity of the explanation of the invention, this exemplifying 
embodiment is based on relations assuming there is no lateral movement. In the relations: 

(4M5) 

v> is the yaw rate from a gyro; 

vx is the velocity of the vehicle in the x-direction; 

ay is the acceleration in the y-direction. The curve radius is computed according 
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to the following relation, whne R is defined as the distance to the center of the rear wheel 

axle, 

(6) 

V. R-y^ 

The angular wheel velocities a? for each of the respective wheels are received 
from an ABS and the inverse /f'' of R is solved in order to avoid numerical problems in 
certain driving cases, e.g. driving straight ahead. This resulu in 
(7) 



where the v^eel nulius is denoted r 

The wheel radii ratio is subject to an offset: 

(8) 

Hie influence of the o£&et on the denmninator is negligible, so according to 
embodiments of the invention the following expression is used for inverse curve radius: 
(9) 



ABS 



wherein the computable quantity 
(10) 



is used for the inverse curve radius. 
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Finally, the velocity at the center of the rear wheel axle is 



(11) 



2 



V. = ■ - J - r 
where r denotes the nominal wheel radius. 

In a practical implementation of this embodiment, the sensor measurements are: 
y\(i) from a yaw rate senson i.e. gyro signal; 

yiix) - v^Rl* , fi:om ABS srasors, a;;* is computed as above; and possibly 
y^it) from a lateral acceleration sensor. 

It should be noted that when a lateral accelerometer is used, this is prefeirably supported by 
a vertical accelerometer to compensate for non-horizontal movements of the vehicle. 

All these sensor measurements are subject to an offset and measurement noise 
given by die relations: 



15 



20 



1 



(12) 

where SABS is an offset that depends on relative tire radius between left and right wheels. 

As has been described above, the measurement signals are treated in a filter. A 
general filter description is given in the following section. In one embodiment, the offset is 
estimated by means of the least squares method. So, eliminating the yaw rate from the first 
two measurements yields a linear regression in the two offsets: 
(13) 

where: 
(14) 

r 



^(0 = 



1 2 a>^ 



Lo>, 



-=-+1 



«(0 = e,(/)-«,(/) 
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Using also an accelerameter. the regression quantities are 
(15) 



(16) 



e(/) = e,(0-- 
The least squares estimate is computed by 



The important question of idcntifiability, that is, under what conditions are the 
ofisets possible to estimate, is answered by studying the rank of the matrix to be inverted in 
10 the LS solution. For the accelerometer sensor, the matrix is given by: 
(17) 




1 5 In short, this matrix has fall rank if and only if the velocity changes during the time horizon. 
Furthennore, the more variation, die better estimate. Similarly, the offsets are identifiable 
from yaw rate and ABS sensors if the velocity or the curve radius changes anytime. In 
accordance with die invention, the of&ets are estimated adaprivefy by recursive least 
squares (RLS) algorithm, least mean square (LMS) or a Kahnan filter. 

20 In real time implementations of the invention, the Kalman filter is preferred and 
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improves the pcrfonnance over RLS in the following way: 

- Firstiy, a model for the variation of the true yaw rate can be incorporated in the Kalman 
filter. For instance, the yaw rate may be limited to 5Hz maximum frequency variation. 

- Secondly, different time-variations of the sensor offsets can be used. For instance, 
temperature can influence the gyro ofbct variation, a cold start can make the filter forget 
more of die gyro of&et than the ABS offset 

The Kalman filter is completely specified by a state space equation of the form 



(18) 



y{t)^Cx(the{t) 



where the covariaoce matrices of v(t) and e(t) are denoted Q and R, respectively. 
The unknown quanddes in the slate vector x(t) are estimated by a recursion 
(19) 

i{t+\) = Ax{t)* K(t.A,B,C.Q,RMhCx{t)) 



w*ere the filter gain K(t;A,B. C, Q.R) is given by the Kalman filter equations.TTius, the 
problem when designing an implementation is to setup the state space model. 
An exemplifying embodiment uses the state vector 

(20) 



and a continuous time state space model is: 
(2la) 



x(0 = 



ro 1 0 

0 0 0 0 

0 0 0 0 

i^o 0 0 o; 



^0^ 

1 



v(/) 



(21b) 
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1 0 1 



1 0 0 V 



1 2 (o^ 

'On 



r(/)**(0 



It is here assumed that there is an unknown input v(t) that afiFects the yaw acceleration, 
which is a common model for motion models, basically motivated by Newton's law F » ma. 



A discrete time state space model: 
(22) 
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is derived and is used by the Kalman filter. 

Embodiments of the invention integrating information firom wheel speed signals 
and gyro are thus capable to give accurate yaw angle and yaw rate measurements where the 
gyro offset and relative tire radii differences are estimated and compensated for. As an 
alternative, or further support, to ABS. one or several lateral accelerometers can be used to 
support the yaw rate sensor with a further yaw rate dependent sensor signal. 

Simulations and e}q>eriments show that the accuracy in yaw rate, not regarding 
the ofisets, is better than usmg any of the sensor ^pes separately. Fig 4 shows a plotted 
diagram 40 1 of a Kabnan filter estimated gyro ofiEset 403 compared with a very exact 
ofiBine adjusted offset 402, the diagram having the time in seconds on the x*axis and gyro 
ofiEset in rad/s on the y-axis. The diagram of fig 4 is a registration from an experimental test 
drive and shows that the Kalman filter estimation after a short transitional period converges 
with the ofiQine adjusted offset within a margin of a few percentages of ofifset scale units. 
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A further advantage witii the inventive concept is that the relative diiference in 
wheel radii on non-driven ri^t and left wheels can be very accurately estimated, which is 
advantageously used for tire pressure indication In different embodiments the Kalman filter 
is used as a combined parameter estimator for the ofEset as well as a filter for yaw rate. In 
an alternative embodiment, an adaptive filter is used to estimate the offset parameters. A 
further effect of the invention is timt it gives support for diagnosis of faults in gyro and 
accelerometer. 

In a stepwise description of tiie embodiment for yaw rate estimation* the 
inventive method comprises the following steps: 

( 1 ) Collecting measurements from (a) a yaw rate gyro 

(b) ABS Sensors 

(c) possibly a lateral accelerometer 

(d) possibly wheel steering angle sensor 

(2) Preprocessing and filtering of raw sensordata 
1 Scaling of sensor inputs to physical constants 

yawrate « nom«scale_factor^gyro * rawinputgyro - 
nom.of f set_gyro. 

2 Low-pass filtering of yaw rate to reduce quantization and noise enor effects for 
instance averaging over a few samples* 

3 Rotational synchronization of cog stamps to avoid cog deforaiity error effects 
i.e. calculate wheel angular velocity by using a full revolution of the wheel 

4 Similar treatment of sensors (c) and (d) to reduce known error effects for 
instance low-pass filtering. 

5 Performing shnple diagnosis on sensors to take care of sensor built-in diagnosis 
functions for instance sensors using a zero level voltage to indicate internal fidlure. 

(3) Calculating filter inputs and parameters in error model 

1 Calculate the inverse curve radii estimate fix>m front axle wheelage 

2 Calculate the hiverse curve radii estimate from rear axle wheelage (with indices 
changed to wfl and wfi:) 

3 Calculate the vdiicle velocity estimate firom ABS sensors 

4 Calculate the yaw rate estimate firom front and rear wheehige 

5 Calculate the wheel radii offset eiror propagation function for rear axle 

6 Calculate the wheel radii of&ct error propagation function for front axle 

(4) Examine data quaii^ by given norms to produce statistical matrices for Kalman 
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Filtering, for instance: 

1 Low velocity increases noise and other errors in yaw rate from ABS sensors 

estimated 

if (velocity^cstimate < LOW_^LEVEL) 
S Increase values in Kalmaa measurement covariance 

matrix R 

2 Standstill car assures yaw rate to be exactly zm> 

if (vclocity^cstimate = ABSOLUTE_ZERO) 

Decrease values in Kalman measurement covariance 

10 matrix R 

(5) Applying the Kalman Filter equations 

1 Time update of Kalman Filter 

xhat « F*xhat; 
Phat » F*Phat*F'+ G*Q*G' ; 
1 S 2 Measurement update of Kalman Filter 

K =» Phat*H**inv(H*Phat*H'+R) ; 
e a y - H*xhat; 
xhat = xhat + K*e; 
Phat Phat - K*H*Phat*; 
20 Phat « 0,5* (Phat + Phat'); 

Where xhat is the current state estimate and Phat is the current Kalman error covariance 
matrix* y is current measurement, H is measurement matrix, F is state space model update 
matrix and G is noise update matrix. 

(6) Output of yaw rate and o&et estimates 

25 1 Provide a fast yaw rate which is the current measured low*pass filtered yaw rate 

minus the estimated ofi&et to be used by for instance time*critical control systems. 

2 Provide a filtered yaw rate which is the current yaw rate state estimate of the 
Kalman Filter to be used by for instance navigation systems. 

3 Provide relative wheel radii between left and right wheels on rear and front 
30 wheelage to be used for instance by tire presstire estimation systems. 

4 Provide the rate gyro offset estimate to be used in dis^pM)sis functions. 



Velocity Computation 

One embodiment of the invention is concerned with applying the invention for 
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veJocity computation, or more generally expressed longitudinal motion computation based 
on standard sensors of a vehicle. In accordance with the invention, a sensor signal from an 
accelcrometer ax is integrated with a wheel angular velocity signal © for example from an 
ABS in a sensor signal integration unit 218. The sensor signal integration unit comprises, as 
S explained above, a filtering process, and outputs a computed velocity signal vx 220 and a 
computed acceleration signal ax 721, As described above, an accelmmeter sensing 
acceleration in the horizontal plane is preferably combined with a vertical accelcrometer for 
compensation for vertical motion. Since this embodiment uses an accelerometer as a 
complement to the wheel speed signals, the velocity can be computed after locking the 

10 ^^lieels when braking. 

The basic equations upon which the computation is based are similar to those 
described above in connection with the yaw rate computation. Therefore, only the sensor 
signals to be fused and their characteristics are shown here. Wheel angular speed signals g> 
are received from an ABS and are transfomted to a scaled velocities at selected positions in 

IS the car. The first sensor signal fiom the ABS is described by: 
(23) 

yAn = v,(/) + e,(t) 

whmin y I is the angular velocity of a driving wheel; 
vx is the absolute velocity of the wheel; 
r is Qie wheel radius; 
20 k is the slip^slope; 

S is the slip offset; and 
fi is the wheel momentum. 

The ofiGset 

(24) 

r 

25 

is here multiplicative, which means that die relations are non linear and die extended 
Kalman fihcr must be used» The sensor is accurate at medium frequencies, at a time scale 
where the friction and tire characteristics k, S are unchanged. 

The second sensor signal bom an accelerometer in longitudinal direction a, is described by: 
30 (25) 
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Summing up to time t gives: 
(26) 

>'2(')=I^jW = v,(0-v,(0)+V + e,(0 

The offset scalings (1 and t) are linearly independent if the traction force « fd(t) 
does not increase linearly in time, so the offsets A;, k, 5are observable. In this embodiment, 
offset and drift free velocity is computed firom driven wheel speed and accelerometer with 
non-negligible offset for instance to be used in 4WD vehicles when free-rolling wheels are 
not available. It also has a fast response to longitudinal velocity changes during skid, i.e. 
spin or brake. Furtbennore, the embodiment is advantageously used for diagnosis of 
accelerometer. The system estimates the slip slope in a friction model v^ch is also used to 
estimate tire*ioad friction. 

In a stepwise description of the embodiment for velocity computation, the 
inventive method comprises the following steps: 

(1) Collection of measurements from 

(a) a longitudinal accelerometer 

(b) ABSSaisors 

(c) possibly a yaw rate gyro 

(2) Preprocessing and filtering of raw sensordata 
1 Scaling of sensor inputs to physical constants 

2 Low-pass filtering of longitudinal acceleration measurement to reduce 
quantization and noise error effects for instance averaging over a few samples. 

3 Rotational synchronization of cog stamps to avoid cog defomuty error effects 
i.e. calculate >^eel angular velocity by using a full revolution of the wheel. 

4 Perform sin^^le diagnosis on sensors to take care of sensor built-in diagnosis 
functions for instance s^isors using a zero level voltage to indicate internal failure. 

. (3) Calculation of filter inputs and parameters in error model 

1 Calculate the vehicle velocity estimate from ABS sensors (Page 8 - Eq 1 1 ) 

2 Calculate the parameters in the error model (Page 12 - Eq 23) 

3 Calculate current matrices for the extended Kalman Filter (F, G, H, Q) 
(4) Examine data quality by given norms to produce statistical matrices for Kalman 
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Filtering, for instance: 

1 Low velocity increases noise in velocity measurement from ABS sensors 

if (velocity_estimale < LOW^LEVEL) 

Increase values in Kalman measurement covariance 

matrix R 

2 Standstill car assures velocity to be exactly zero 

if (vclocity.estimate = ABSOLUTE.ZERO) 

Decrease values in Kalman measurement covariance 

matrix R 

(5) Applying the Kalman Filter equations for the extended Kalman Filter 

1 Time update of Kalman Filter 
xhat » F*xhat; 
Phat » F*Phat*F'+ G*Q*G' ; 
2 Measurement update of Kalman Filter 
K « Phat*H'*inv(H*Phat*H'+R) ; 
e » y - H*xhat; 
xhat » xhat + K*e; 
Phat = Phat - K*H*Phat'; 
Phat - 0.5* {Phat + Phat'); 
Where xhat is the current state estimate and Phat is the current Kahnan error covariance 
matrix, y is current measurement, H is measurement matrix, F is state space model update 
matrix and G is noise update matrix. 

(6) Output of velocity and offset estimates 

1 Provide a velocity estimate for control systems and MMI. 

2 Provide i^eel slips for 4 WD vehicles 

3 Provide the accelerometer oi&et estimate to be used in diagnosis functions. 

Fuel Level and Fuel C ^ft^^«T[ipt^ on Sensor 

An embodiment of the invention is directed to computation of fuel level and fuel 
consumption. This embodiment is schematically shown in Fig 2C and takes as an input a 
fad volume signal 224 from the tank meter of the vehicle and a fiiel injection signal 226 
from the engine. The basic equations are again similar to those described above, however 
the sensor signals are modelled according to the following equations. 

Firstly, the tank level measurement is: 
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(27) 

>'>{')=KO+*,+e,(r) 
This type of sensor usually suffers from medium-frequency disturbances in the noise 

component el(t), which is normally handled with a very slow low-pass filter. On the other 

hand, low-frequency accuracy in the time constant of one re-fuelling is good. The of&et 

depends inter alia on manufiacturing variations and temperature* 

Secondly, a fuel injection signal tq or the like is transformed to a momentary fuel 

consimq>tion signal described as: 

(28) 

y^{!)^nt)^b,^e,{f) 
This sensor is very good at high frequencies, basically since it measures derivatives. 
Summing up to time t gives: 

(29) 

yi (0= t^yiif)^ V{fyv(Q)^b,t + (/) 
The offset scalings 1 and t are linearly independent and therefore the offsets are observable. 

This in effect virtual sensor has the advantages of fast response after re-fuelling, 
is an offset free monitor of momentary as well as average values of fuel consumption, and is 
suitable to use for diagnosis of faults in fuel pipes and engine efficiency. 

In a stepwise description of the embodiment for fiiel constmiption, the inventive 
method comprises the following steps: 

(1) Collection of measurements from (a) a tank level measurement device 

(b) fuel injection signal 

(2) Preprocessing and filtering of raw sensordata 
1 Scaling of sensor inputs to physical constants 

2 Low-pass filtering of fuel injection measurement to reduce quantization and 
noise error effects for instance averaging over a few samples. 

3 Perform simple diagnosis on sensors to take care of sensor built-in diagnosis 
functions for instance sensors using a zero level voltage to indicate internal &ilure. 

(3) Calculation of filter inputs and parameters in error model 

1 Calculate the tank fiiel level estimate from fuel level sensor 
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2 Calculate the fuel consumption from fuel injection signal 

(4) Examine data quality by given norms to produce statistical matrices for Kalman 
Filtering* for instance: 

5 1 High load on engine gives unreliable consumption results, increase part of R 

(5) Applying the Kalman Filter equations 

1 Time tq>date of Kalman Filter 
xhat = F*xhat; 
10 Phat « F*Phat*F'+ G*Q*G'; 

2 Measurement update of Kabnan Filter 
K » Phat*H**inv(H*Phat*H'+R); 
e * y - H*xhat; 
xhat * xhat + K*e; 
15 Phat « Phat - K*H*Phat'; 

Phat = 0*5* (Phat + Phaf); 
Where xhat is the current state estimate and Phat is the current Kahnan error covariance 
matrix, y is current measurement, H is measurement matrix, F is state space model update 
matrix and G is noise update matrix. 
20 (6) Output of fuel level fuel consumption and offset estimates 

1 Provide fuel level for MMI systems. 

2 Provide fuel comsumption level for control systems and MMI systems 

Virtual Sensor for an Absolute Velocity Indicator 

25 One embodiment of the invention is applied in velocity computation, or more 

generally expressed longitudinal motion computation based on standard sensors of a 
vehicle. In accordance with a variety of this embodiment, a sensor signal from an 
accelerometer is integrated with a wheel angular velocity signal o) (for example from an 
ABS unit) in a sensor signal integration unit The sensor signal integration unit comprises, 

30 as explained above, a filtering process, and outputs a computed velocity signal and a 
computed acceleration signal a, . As described above, an accelerometer sensing 
acceleration in the horizontal plane is preferably combined with a vertical accelerometer for 
compensation for vertical motion. Since this embodiment uses an accelerometer as a 
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complement to the wheel speed signals, the velocity can be computed also after locking the 
wheels when braking. 

Wheel angular speed signals oo are received from an ABS and are transformed to 
scaled velocities at selected positions in the car. The first sensor signal £tom the ABS is 
described Iq^ 
(30) 

where is the angular velocity of a driving wheel, v^, is the absolute velocity of the wheel, 
r is the wheel radius, k is the longitudinal stiffiiess, S is the slip offset, ^ is the nonnalized 
traction force, and is measurement noise. 
The of&et 

r 

(3 l)is here multiplicative, which means that the relations are non*linear and a non-linear 
observer or the extended Kaknan filter must be used. The sensor is accurate at medium 
frequencies, at a time scale vAam the fiiction and tire characteristics, i and J, are 
unchanged. 

The second sensor signal from an accelerometer in longitudinal direction a. is described by 
y2(0"v,(0+63+c2(/). 

Sununing up this equation to time t gives 
(33) 

The of&et scalings (1 and t) are Uneariy independent if the normalized traction force ^t) 
does not increase linearly in time, so the offsets b2^kySm observable. 
In this embodimem, offset and drift free velocity is computed from driven wheel speed and 
accelerometer vdth non^negligible offset for instance to be used in 4 WD vehicles when 
firee-roUing M^eels are not available. It also has a fast response to longitudinal velocity 
changes during skid, i.e. spin or brake. Furthermore, the embodiment is advantageously 
used for diagnosis of the accelerometer. The system estimates the slip slope in a friction 
model v^ch is also used to estimate tire-road friction. 
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In a stepwise description of the embodiment for velocity coroputaiion» the 
inventive method comprises the following steps: 

(1) Collectich of measurements from: 

(a) a longitudinal accelercmeter 

(b) ABS Sensors 

(c) possibly a yaw mte gyro 

(2) Prepiocessing and filtering of raw sensoidata: 
Scaling of sensor ii^uts to physical constants 

Low-pass filtering of longitudinal acceleration measurement to reduce quantization and 
noise error effects for instance averaging over a few samples. 

Rotational synchronization of cog stamps to avoid cog deformity error efiects, i.e., calculate 
wheel angular velocity by using a fiill revolution of the wheel 
Perform simple diagnosis on sensors to take care of sensor built-in diagnosis functions for 
instance sensors using a zero level voltage to indicate internal fiailure. 

(3) Calculation of filter inputs and parameters in error model: 
Calculate the vehicle velocity estimate fiom ABS sensors 
Calculatejhe parameters in the error model 

Calculate current^maSiceTforthe extende^'Kalzpn Filfer(T', G, H,Q) 

(4) Examine data quality-bsLgi xen norms to produce statistical matrices for Kalman 
Filtering* for instance: 

Low velocity increases noise in velocity measurement from ABS sensors 
if (velocity_estimate < LOW^LEVEL) 
Increase values in Kalman measurement covariance matrix R 

Standstill car assures velocity to be exactly zero 

if (velocity^estimate ABSOLUTE^ZERO) 

Decrease values in Kalman measurement covariance matrix R 

(5) Applying the Kalman filter equations for the extended Kalman filter: 
(a) Time update 



(33) 



(b) Measurement update 
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Where is the cuireot state estimate, ?^ is the current state error covariance matrix, 
S and y^, is current measurement The state space matrices /; , and are obtained by 
linearizing the non-linear state space model around the current state estimate jc^^ . 
The results and uses of velocity and offset estimates in accordance with this embodiment 
are for example to provide a velocity estimate for control systems and MMI (man machine 
interface), to provide \^el slip indications or estimates for 4WD vehicles, and to provide 
1 0 an accelerometer offset estimate to be used in diagnosis fimctions. 

Sensor for a Roll Aneel Indicator 

An embodimoit of the invention being applicable for a virtual sensor as well as 
for an autocalibrating sensor is directed to achieve a roll angle indicator3y way of 
1 5 example, the described embodiment uses a lateral and a vertical accelerometer^ a yaw rate 
gyro and a vejodty estimate. The measurement from the lateral accelerometer is denoted 
Oy and from the vertical accelerometer a, . The required velocity is in this example provided 
by the ABS by rescaling the angular velocity with the wheel radius. 

A conunon problem with accelerometers is a temperature dependent sensor 
20 of&et. This invention provides an alternative to the costly solution of calibrating ail sensors 
during productim also entailing that an additional temperature sensor is required on each 
motorcade* An embodiment of the invention is adapted to estimate and compensate for the 
sensor o&ets automatically during driving. 

Accelmmeters and gyros typically deliver a continuous time signal. In order to 
23 use this signal in a discrete time system this signal must be sampled using a suitable 

sampling rate. Alias effects are avoided by using an and alias filter (LP-filter) before the 
sampling. Outliers deteriorates the perfonnancc of the system and arc removed before the 
sensor fusion stage. The sensor fusion is performed using an adaptive filter, preferrably a 
Kalman fiher. 

30 Models describing the accelerometers are derived using mechanical engineeringe. The 
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genenU expression, for an ideal lateral and an ideal vertical accelerometcr moving in a field 

of gravity are: 

(35) 

mth notation foramotorcycle in accordance «athtteiU 

Fig 5A. the sensor configuration in Fig 5B and according to tiie following. 



Symbol 


n Meaning ~ • 


u 


Longitudinal velocity " " ' 


u 


Longitudmai acceleration 


V 


[ Lateral velocity — — ^ 




Laterai acceleration 


w . 


Vertical velocity ' 




1 Vertical acceierati^ ' " 




Roll angle " " 


9 


1 Angular velocity around local axle x 


9 


Angular acceleration around local axle i 


e 


Fitch angle ■ 




Angularvelocity around local axle y 




Angular acceleration around local axle y 


9 


Angular velocity around iocal axle i 




Angular acceleration around local axle i 


X [ 


Position of sensor in coordinate axle x 




Position ofsensor in coordinate axle } 


^ 1 


Position ot sensor in coordinate axle i 


g 


Gravity (g«i9.8l|wA2]) 



For a nu>torcycIe is die lateral velocity v and vertical velocity w approximately zero during 
normal driving. TT,e expressions are further simplified if the location of the accelerometers 
are chosen to jmo, ^/t^oand lai,. 
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The sensor models are simplified to 
(36) 

If e is assumed to be constant equal to zero are 

It is now obvious that the local roll rate <p is equal to the global roll rate 6 and also that 
^ can be eliminated from the accelerometer models. 

The first terra in the expressions^ or m^' tan <D , is important for modelling high velocity 
10 turns. The increased normal force on the motorcycle from the ground is explained by this 
temi. The second term depends on the location of the sensor in i and the third is the 
mfluence from gravity.Unfortunately there are two allowed solutions to these two 
expressions. In order to improve the system is one more interpretation of the lateral 
measurement required TUs inteipretation is made using necessary conditions to achieve 
1 S state of equilibrium in steady state turning. 

Using Newtons equations is the following expression derived 



Symbol 


Meaning 


m 


Total mass, driver + motorcycle + load 


h 


Moment of in^ia front wheel 




Moment of inertia rear v^eel 


n 


Wheel radius front wheel 




Whel ladtus rear wheel 




Parameter dependent on MC geometry 




Parameter dq>endent on MC geometry 




Distance ground to center of mass 
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e 


Tilt 


*« 


RoU angle to the CoM driver -•■ MC 



Introduce the parameter 




which describes the physical properties of the particular type of motorcycle. Assuming 
S o^oO results in 

g cos 6 sin O a >u ^iT - « ^ + 

Assume constant pitch angle ©aO and use ^»^tanO 
gcos9sin4> ^^ydC^u^f ^a\fp^c^^^ tan<t> 

Inserting this expression in the earlier derived expression for the lateral accelerometer 
10 yields 

where the new variables a, and are constants describing the geometry of the motorcycle 
but are not equal to a; and a,. 

There are now one model for the vertical and two models for the lateral 
IS accelerometer available. 

f ^ " "1^ - 'tP + - ^ ten <P + g sin O 

a^, » -ms^ tan O - J, (jp ' + 4/ 2 tan ' 0)4- g cos O 

A rate gyro model follows from that the rate gyro is attached in the longitudinal 
direction x and measures ideally the roll angle derivative or gyro » p 
There are now one sensor model for the ideal vertical acceleromter« two models for the 
20 ideal lateral acceleromter and one model for the ideal mte gyro. An improved model is 
achieved if the model is extended with additive sensor offsets: 
Qfiy =«^^'-j.,^>+z,i^^tan«P+gsin<P + ^^ 

where the notation is as presented earlier and 
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Notation 


Meaning 




Sensor of&et lateral accelerometer 




Sensor offset vertical accelerometer 




Sensor offset gyro 



The adaptive filter is in this embodiment implemented by means of an extended 
kalman filter, A continuous time state space model is derived and is then transformed to a 
discrete time state space model using per se known theory from linear systems and sampled 
systems. The continuous time state space model for the system is 
x = Ax + Bw 

The state vector x consists of seven elements x » (x, xy x, Y , wherein: 

X, s ^ = Rotation around x 

X J a ^ a Angular velocity aroxmd x 

X3 s ^ = Angular acceleration around x 

x^=(^^ Angular velocity around i 

X5 ^ = Accelerometer offset lateral accelerometer 

x« » Accelerometer offset vertical accelerometer 

X7 «tf^=Gyroo£feet. 



n 
0 
0 
0 
0 
0 
0 



0^ 
0 
0 
0 
0 
0 
0) 



4!) 



'0 
0 

I 

h 0 

0 
0 

u 



4) 



A B 

^^^A - tan X, + g sin x, +X5 

a|X3 -f-a^xj tanx} -uffyt^K^x^ 

'2 , 



Kv(r) 



The discrete time kalman filter is written 



wo 01/76925 



30 



PCT/SEOl/00797 



Where T is the sampling time. Derivation of F and G from A and B is straightforward 
according to the theoiy for sampled systems. 



rV2 

T 
I 

0 
0 
0 
0 



^rV6 

T 
0 
0 
0 
0 



^jTj + ZjXfl tan Of, + gsin X, + X5 



-Kj^X4 lanx, -r,(»| lan^ x,)+^cosx, 



Writing the discrete time signal model z » a(x), the extended Kalman filter is 
applied as follows. 

10 Here f» g and h are nonlinear functions of the states x* . Define the matrices F, G and H 
according to: 

F 

15 The linearized signal model be written as 
where 
and 
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10 



The extended Kalman filter equations are then 

Zk/k ^Za/*<| '^tt'^* Z*/*-l ^* -^^kY^^k Z*/*-l 

Initialisation is provided by: Zo/-.i»fli.JfoM «jfo« 

The necessary matrices for the roll angle estimation problem using two 
accelerometers the velocity of the motorcycle and an extended kalmanfilter are: 






T 


rV2 


0 


0 


0 


o] 


0 


I 


T 


0 


0 


0 


0 


0 


0 


1 


0 


0 


0 


0 


0. 


0 


0 


1 


0 


0 


0 


0 


0 


0 


0 


1 


0 


0 


0 


0 


0 


0 


0 


I 


0 


.0 


0 


0 


0 


0 


0 





*8k 



frV6 

T 
0 
0 
0 
0 



0 
0 
0 
0 
0 
0 
Tj 



15 



r 



-1/1^X4(1+ tan- X, 



^'(l + tan^ Xi)+gcosx, 
i)-2zjfx} tanX|(j + uui 

0 



0 -r^ i/^ +2zyX4 tanx, 10 0 

)-sinx, -2x,X2 0 -i/tanx, -22,X4 lan^ x, 0 10 

0 o, 202^4 tanx, -u/r I 0 0 

1 0 0 6 0 r 



All that remains in order to run the aJgorithm is the initialization, xq is chosen to 
suitable values and the matrix Pq reflects the uncertainty of x© . One choice is 
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5 

The described mathematical expressions are employed for example in a virtual 
sensor as shovm in Fig 6, taking as an iqput a selection of yaw signal from gyro, lateral 
acceleration signal ay, vertical acceleration signal az and wheel angular velocity signal of. 
The sensor signals are preferably preprocessed by being low pass filtered in stage 602, 
10 sampled in stage 604, low pass filtered in stage 606 and data reduced in stage 608. The 
angular velocity signal is preferably also rescaled in stage 610. The thus preprocessed 
sensor signals are the input into an adq)tive filter 612 based on a model in accordance with 
the previous description. The onxpm of the filter are values or signals for a'roU angle» sensor 
offsets and yaw rate. 

15 

Virtual Sensor for Fuel Level and Fuel Consumption 

One embodiment of the invention is directed to computation of fuel level and fuel 
consumption. This embodiment takes as an input a fuel volume signal from the tank meter 
of the vehicle, and a fuel injection signal from the engine. The basic equations are again 
20 similar to those described in earlier sections, however the sensor signals are modelled 
according to tiie following equations. 

Firstly, the tank level measurement is: 

This type of sensor usually suffm from medium frequency disturbances in the noise 
25 component which is nomially bandied with a very slow low-pass filter. On the other 
hand, low>fi:equency acctoacy in the time constant of one re-fiielling is good. The ofhtt 
depends inter alia on manufacturing variations and temperature. 

Secondly, a fuel injection signal tq or the like is transformed to a momentary fuel 
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consumption signal described as 

This sensor is veiy good at high frequencies, basically since it measures derivatives. 
Sununing up to time t gives: 

The ofiset scalings 1 and t are linearly independent and therefore the offsets are observable. 

This in effect virtual sensor has the advanuges of fast response after re-fuelling, 
is an offset free monitor of momentaiy as well as average values of fuel consumption, and is 
suitable to \ise for diagnosis of &ults in fuel pipes and engine efTiciency. 

In a stepwise description of the embodiment for fuel consumption, the inventive 
method comprises the following steps: 

1 . Collection of measurements from: 

(a) a tank level measurement device; 

(b) a fuel injection signal 

2. Preprocessing and filtering of raw sensor data: 

(a) Scaling of sensor inputs to physical constants 

(b) Low-pass filtering of fuel injection measurement to reduce quantization and noise 
error effects for instance averaging over a few samples. 

(c) Perfomi simple diagnosis on sensors to take care of sensor buili-in diagnosis 
functions for instance sensors using a zero level voltage to indicate internal failure. 

3. Calculation offilter inputs and parameters in error model: 

(a) Calculate die tank fuel level estimate from fuel level sensor 

(b) Calculate the fuel consumption from fuel injection signal 

4. Examine data quality by given norms to produce statistical matrices for Kalman 
Filtering, for instance: 

(a) High load on engine gives unreliable consumption results, increase part of R 

5. Applying the Kalman Filter equations 
(a) Time update of Kalman Filter 
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Pk-FkPk.xFl^G,Qfil 

(b) Measurement update of Kalman Filter 

5 

where ij^ is the. The state space matrices , and Hj^ are obtained by linearizing the 
non current state estimate, Z*^ is the current state error covariancc matrix, andj/^ is the 
current measurement -linear state space model around the current state estimate . 

1 0 6. Output of fuel level fuel consumption and offset estimates 

(a) Provide fuel level for MMI systems. 

(b) Provide fuel comsumption level for control systems and MMI systems 

Virtual Sensor for Aoua Planning Detect^gi^ 
1 5 One embodiment of the invention is directed to automatic aqua planning detection (APD) 
based on the follovdng principles.The measured signals and computed quantities that are 
utilized by the virtual sensor APD are summarized shown in Fig 7 and the following table. 



Symbol 


Description 




Angular velocity, driven wheel [ta&ls] 




Angular velocity, non-driven wheel [rad/s] 




Wheel radius, driven wheel [m] 




Wheel radius, non-driven wheel [m] 




Engine torque [Nm] 


/ 


Geanng ratio from engine to driven wheels [-] 




Ncnmal force at driven wheel [N] 


s 


Wheel slip H 



wo 01/76935 



35 



PCT/SE01/00797 



7i I Normalized traction force [-] 



Fig 8 shows a schematic view of the fiinctionai components in a variety of this 
embodiment, viz vehicle signals 802 are input into a prccomputaiion or preprocessing stage 
804, The precomputed output is the filtered in an adaptive filtering process stage 806 in 
accordance with the inventive concept producing output parameter signals that axe subject 
to evaluation or used in a diagnosis in stage 808.' 

The virtual sensor APD detects aqua planning by monitoring the longitudinal 
stiffness k , which during nomial driving conditions can be modeled as 

s 

where 

is the normalized traction force and 

is the wheel slip. Here is the tire normal force that depends on the mass, the vehicle 
geometry and the vehicle state (such as the current velocity and acceleration/retardation). 
In case of aqua planning, the lack of friction between t he tire and the road gives rise to an 
increased wheel slip s if the traction force ju is niabtained. ThCTiSbrc, it is possiH!e!o~~ 
detect aqua planning by monitoring sudden decreases in the estimated slope parameter * , 
In practice it is necessary to take into account that the wheel radii r^ and r„ are unknown. 
By introducing <5 as the relative difference in wheel radii, i.e., 

and approximating the wheel slip as 
and approximating die v^el slip as 




obtains the model 
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The parameters in tbis model, 1/^ and ^ » are estimated from measured slip s„ and traction 
force // using an adaptive filter, such as a recursive least squares algorithm or a tCalman 
filter and the state space model 

where = (]/* Sf, (ji, if^ and and are process and measurement noise 
respectively. 

The invention has been described by means of exemplifying embodiments for 
different applications and it should be appreciated that several designs are possible within 
the inventive concept and as defined in the claims. 
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Claims 



1 . A sensor system in a vehicle comprising: 
S • a fust sensor (102) being capable of generating a first sensor signal (SI) dependent on 

a first physical parameter; 

- a second sensor (104) being capable of generating a second sensor signal (S2) 
dependent on a second physical parameten 

- a filtering means receiving as an input said first and second sensor signals (S 1 ,S2) and 
10 being devised to recursively estimotixig the value of said first physical parameter on the 

basis of said first and second sensor signals (S1,S2); and 

- an output for a physical parameter signal (PSSUPSS2,PSS3,PSS4) having said 
estimated value. 

15 2. The sensor system of claim 1 , finrther comprising a sensor signal processing unit 
(1 12,1 14»1 16,1 17) receiving as an input said physical parameter signal and being 
devised to compute a second sensor signal (VSS,ISS,DS,VCS) corresponding to a 
second physical parameter dependent on said first physical parameter. 

20 3. The sensor system of claim 2, fiirther comprising a control unit (1 18) receiving as an 

input said second sensor signal (VSS) and being devised to generate a control signal for 
a vehicle control system. 

4. The sensor system of claim 2* fiirther comprisbg an information processing unit ( 1 20) 
25 receiveing as an input said second sensor signal (ISS,DS) and being devised to generate 

a status signal representing a physical condition of the vehicle. 

5. The sensor system of claim 2, wherein the sensor signal processing unit ( 1 1 7) is devised 
to generate a vehicle control signal (VCS) for connrolling a vehicle operating 

30 apparatuses. 

6. A method for computing a physical parameter value in a wheeled vehicle, comprising 
the steps of: 

-receiving a first sensor signal (SI) dependent on a first physical parameter. 
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•receiving a second sensor signal (S2) dependent on a second physical parameter; 
•recursively filtering said first and second sensor signals (Sl,S2); 
-computing an estimated parameter offset value for each of said first and second sensor 
signals (SI, S2); 

•computing an estimated physical parameter value dependent on said first and second 
sensor signals (S 1 ,S2) and said offset values. 

The method of claim 6, further comprising the step of computing a second sensor signal 
(VSS JSS,DS,VCS) corresponding to a second physical parameter dependent on said 
first physical parameter. 

The method of claim 7, further comprising the step of generating a control signal for a 
vehicle control system dq)endent on second sensor signal (VSS). 

The method of claim 7« further comprising the step of generating^ dependent on said 
second sensor signal GSS,DSX a status signal r^resenting a physical condition of the 
vehicle. ' 

10. The method of claim 7, further comprising the step of generating a vehicle control 
20 signal (VCS) for controlling a vehicle operating apparatuses. 

11. A computer program product for computing a physical parameter value of a wheeled 
vehicle in a data processing system, comprising means for directing the data processing 
system to: 

2S -receive a first sensor signal (S 1 ) dependent on a first physical parameter; 

-receive a second sensor signal (S2) dependent on a second physical parameter; 
-recursively filter said first and second sensor signals (S 1 ,S2); 
-compute an estimated parameter ofSset value for each of said first and second sensor 
signals (S1,S2); 

30 -compute an estimated plQfsical parameter value dependent on said first and second 

sensor signals (SI,S2) and said offset values. 

12. The computer program product of claim 1 1, further comprising means for directing the 
data processing system to compute a second sensor signal (VSS JSS,DS,VCS) 



5 

7. 

10 

8. 

15 9. 
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corresponding to a second physical parameter dependent on said first physical 
parameter. 

13. The computer program product of claim 12, further comprising means for directing the 
data processing ^stem to generate a control agnal for a vehicle control system 
dependent on second sensor signal (VSS). 

14. The computer program product of claim 12, further comprising means for directing the 
data processing system to generate, dependent on said second sensor signal (ISS.DS), a 
status signal representing a physical condition of the vehicle. 

15. The computer program product of claim 12, further comprising means for directing the 
data processing system to generate a vehicle control signal (VCS) for controlling a 
vehicle operating apparatuses. 
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